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b) Cubic  hermite  polynomials  are  usually  C*  continuous.  With  the  introduction  of 
smoothing  within  the  intervals,  the  second  derivatives  can  be  made  continuous. 
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laser  rays  can  be  subjected  to  angular  errors..  These  errors,  in  the  direction 
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INTRODUCTION 


The  smoothing  of  gradients  can  be  obtained  by  using  an  optimization  method 
for  approximation  involving  spline  functions.  A  nonuniform  grid  may  be  employed 
to  compute  by  the  spline  function  method  with  cubic  hermite  polynomials. 
Continuous  second  derivatives  at  the  grid  point  from  both  sides  are  essential 
for  the  purpose  of  smoothing.  This  method  can  be  applied  to  solve  the  following 
problems:  whether  the  platform  can  climb  on  the  estimated  in-path  slope  or 
whether  it  will  tip  over  the  estimated  cross-path  slope. 

RECURSIVE  FILTERING  AND  SMOOTHING  PROCEDURE 

A  spline  function  s(£)  is  a  solution  to  the  optimization  problem 
N  N 

J*  *  Min.  {  E  [hUSO-mi^Ri  [hO,  )-mi]  +  p  E  /  [h]«d*}  (1) 

h  e  C*  i=l  i=2  Pi-1 

where  for  clarity  and  simplicity  in  discussion,  we  only  consider  the  cubic 

spline  case.  A  higher  order  polynomial  spline  can  also  be  treated  in  a  similar 

manner  with  more  complicated  computations. 

A  cubic  spline,  s,  is  a  piecewise  polynomial  of  class  C*  which  has  many 

good  properties,  such  as  the  minimum  norm  property  and  local  base  property  (refs 


1,2).  From  the  approximation  theory,  we  know  that  for  each  set  A  =  (aj,...,aN, 
a'l*  s ' n) «  there  exists  a  unique  cubic  spline  s(?;A)  such  that 

s(/3i;A)  =  a,  ,  i  =  1,2,. ..,N  (2) 

s ( 0 i ; A )  =  a'i#  i  =  1 ,N  (3) 


where  s  is  the  first  derivative  of  the  function  s.  The  above  equations  can  be 


1Ahlberg,  J.  H.,  Nilson,  E.  N.,  and  Walsh,  J.  L.,  The  Theory  of  Splines  and 
Their  Applications.  Academic  Press,  Inc.,  1967. 

2Schumaker,  L.  L.,  Spline  Functions:  Basic  Theory,  John  Wiley  &  Sons,  1981. 


thought  of  as  boundary  conditions  for  the  piecewise  cubic  spline  interpolation 


given  a  set  of  data  (0-j,a-;),  for  i  ■  1,2,...,N.  Thus,  solving  the  problem  in 
Eq.  (1)  is  equivalent  to  determining  a  set  of  constraints  A  for  the  optimization 
problem: 

4 

N  N  0i 

J*  =  Min  {  L  [sUijAl-mi]1^  [s(?i  ;A)-mi]  +  p  E  /  [s($;A)pd£}  (4) 

A  i =1  i=2  0i-l 

Instead  of  taking  a  direct  approach  to  find  an  optimal  set  of  constraints  for 

the  problem  above,  it  is  proposed  to  further  transform  this  problem  into  a  form 

which  is  convenient  to  be  solved.  From  the  theory  of  numerical  analysis  (ref 

3),  it  is  well  known  that  a  piecewise  cubic  Hermite  polynomial  p(£)  is  in  the 

family  of  C1 .  For  each  set  B  =  AuAc,  where  Ac  is  a  complement  of  A,  i.e.,  Ac  = 

{a'.j,  i  s  2,3, . . . ,  N— 1 } ,  then  B  *  {a-j.a'-j,  i=l,2, . . .  ,N} ,  there  exists  a  unique 

piecewise  cubic  Hermite  polynomial  p(?;A)  such  that 

P(0i;B)  *  a-j  ,  i=l»2,...,N  (5) 

p(0i;B)  *  a'^  #  i  =  2, . . . ,N  (6) 

where  p  is  the  first  derivative  of  p. 

It  should  also  be  noted  that  for  each  set  A,  there  are  an  infinite  number 

of  piecewise  Hermite  polynomials  p(?;A)  such  that 

p(0i ; A)  =  ai  ,  i  =  1,2,. ..,N  (7) 

p(0i;A)  =  a',  ,  i  =  1,N  (8) 

Let  a  set  of  p(£;A)  which  satisfies  the  constraints  in  the  equations  above  be  P, 

i.e., 

p  *  {p(€ ; A) : (5) , (6)  satisfied}  (9) 

^Burden,  R.  L.  et  al.,  Numerical  Analysis.  Prindle,  Weber,  &  Schmidt,  1978. 


1 


Referring  to  the  paper  by  de  Boor  (ref  4),  it  is  noted  that  there  exists  a 
unique  cubic  spline  s(?;A)  in  the  set  P.  Also  from  the  minimum  norm  property  of 


a  cubic  spline,  we  have  the  following  relation: 

N  Pi  N  0i 

E  /  [s(?;A) ] 4  4  E  /  [p(?;A) ] * 

i*2  ^i-1  i=2  Pi-1 


i 


(9) 


That  is 


where 


N  0i 

E  /  Cs(«jA)]«  =  inf  JP(p) 

i*2  Pi-1  p  e  P 


N  0i- 

Jp  =  E  /  [p(C;A)]« 

i=2  0 i - 1 


(10) 


(ID 


Since  a  cubic  spline  s(?;A)  is  unique,  a  piecewise  cubic  Hermite  polynomial 
p(£;A)  which  minimizes  the  smoothing  integral  Jp  in  the  above  equation  with 
respect  to  Ac  becomes  a  cubic  spline  s(?;A).  To  be  more  precise,  we  have  the 
following  theorem. 

THEOREM:  Let  P  represent  a  set  of  piecewise  cubic  Hermite  polynomials  p 
which  satisfies  the  constraints  below: 

P ( 0 i ; Ac )  =  a-;  ,  i  =  1,2,  ...N  (12) 

p(0i ;AC)  =  a’i  ,  i  =  1 , N  (13) 

where  p  e  C1,  A,  and  Ac  are  the  same  as  mentioned  before.  Then  there  exists  a 
unique  cubic  spline  s(?)  such  that 


N  /3  *  n  0  * 

E  /  1  [sU)Pd?  *  Min  E  /  1  [p({,AC)]*d{  (14) 

i*2  Pi-1  Ac  i=2  Pi-1 


where  s  and  p  are  the  second  derivatives  of  functions  s  and  p  and  s  e  C2.  A 


simple  example  with  N  ■  3  is  given  next. 


4de  Boor,  C.,  "Bicubid  Spline  Interpolation,”  J.  Math  Phys. .  Vol.  41,  1962, 
pp.  212-218. 


EXAMPLE  FOR  C«  CONTINUITY 


For  convenience  and  simplicity,  we  only  consider  a  special  case  with  N  =  3. 
The  node  points  are  given  as  |8j,  02,  and  03.  The  intervals  are  not  equal,  i.e., 

(02-0i)  *  (03-/32)  (15) 

Let  a  set  of  piecewise  cubic  Hermite  polynomials  p  be 

P  *  [p(t;Ac)  ,  p  e  C1  [t1#t3],  p ( t 2 )  =  a,  a  e  Ac]  (16) 

which  satisfies  the  constraints  in  the  equations  below: 

p(t-j;Ac)  =  a,  ,  for  i  =  1,2,3 
P(*i;Ac)  =  a'-j  ,  for  i  =  1,3  (17) 

In  this  special  case,  a  set  Ac  =  a' 2  =  a. 

We  want  to  show  here  that  the  cubic  Hermite  polynomial  p ( t ; Ac ) ,  which  is 
obtained  by  minimizing  the  smoothing  integral,  will  become  a  cubic  spline  func¬ 
tion  s(t)  €  C2[ti,t3] 

*2-  ••  t3 

J*  =  Min  {/  [p(t;A*)J*dt  ♦  /  tp(t;AC) pdt} 

AC  t2+ 

f  2*  t3 

=  Min  {/  [p(t;a)]*dt  ♦  /  [p(t;a)pdt}  *  (18) 

a  *i  *2 

From  Eq.  (A14)  of  the  Appendix,  the  smoothing  integral  above  can  be  written  as 

J(a)  =  (x2-A1x1)TBi1(x2-A1x1)  +  (X3-A2X2)TB21.(x3-A2X2)  (19) 

"  1 

where  A,-,  ,  and  x-j  are  defined  in  the  Appendix,  and 

x-j  =  (ai,a'i)T  ,  with  a'2  =  a  ,  i  =  1,2,3  (20) 

A-j-i  *  d i _  1  =  t^j-t-j-i  (21) 

Using  Eqs.  (All)  and  (A12),  the  functional  J(a)  is  written  as 


J(a)  =  12dj  (a2-ai-dia'i)2  -  12dj  ^-ai-dja ’ j ) (a-a ' i ) 

"  1  “3 

♦  4dj  (a-a'i)*  +  12d2  (a3-a2-d2a)z 

-*  - 1 

-12d2  (a3-a2-d2a)(a'3-a)  +  4d2  (a’3-a)2  (22) 

Taking  the  partial  derivative  with  respect  to  a  yields 

3J  -a 

--  =  -12d1  (a2-a1-d1a’1)  ♦  8d!  (a-a*!) 

+  24d2a  (a3-a2-d2a) (-d2)  -  12d23  (-d2)(a'3-a) 

-12d2  (-1) (a3-a2-d2a)  -  8d2  (a’3-a)  =  0  (23) 

Solving  the  equation  above  for  a,  one  obtains 

a*  =  [3d!  (a2-ai)-di  a’ !+3d2*a3-d2*  3a2-d21a,3]/[2(d11+d21 ) ]  (24) 

To  show  that  p(t;a*)e  C*[tj,t3],  only  need  to  show  that 

lim  p(t;a*)  =  lim  p(t;a*)  (25) 

t-t2-  t-‘t2+ 


That  is,  for  a  piecewise  cubic  Hermite  polynomial  p, 

Pi, 2^21®*)  *  P2,3(t2J®*) 


(26) 


where  pj^  is  the  cubic  Hermite  polynomial  within  the  interval  and  £2,  and 
P2,3  is  the  cubic  Hermite  polynomial  within  the  interval  02  ®nd  03  • 

Now  from  the  definition  of  piecewise  cubic  Hermite  polynomial  in  the 
Appendix,  we  have 

Pi, 2(^2?®*)  s  6d1*(a1-a2)  +  2d1’a'1  +  4/  a*  (27) 

By  using  Eq.  (24),  the  above  equation  can  be  expressed  as 

Pl,2(t2J®*)  =  [-6®2(dl  +d2  )  +  6 ( ®ldl  +®3d2 )  +  2(a'i-a,3)]/(d1+d2)  (28) 

In  a  like  manner,  omitting  the  detailed  derivation,  we  obtain  easily 

P2,3(t2'*®*)  *  [-6a2(dj  +d2  )  +  6(ajdi  +a3d2  )  +  2(a’i-a'3)]/(di+d2)  (29) 

Thus,  Eq.  (26)  is  always  true,  that  is,  the  conclusion  in  the  theorem  is  valid. 
It  is  proved  that  the  C*  continuity  exists  in  the  optimization  procedure  for 
piecewise  cubic  Hermite  polynomials  with  unequal  intervals. 

CONCLUSION 

For  scanning  in  the  direction  of  elevation  angle  from  the  top  of  a  mast 
where  a  laser  is  located,  the  intervals  needed  in  angles  are  small  for  far  away 
targets,  while  the  same  are  large  for  close-by  objects.  The  smoothing  algorithm 
discussed  in  this  report  indicates  that  piecewise  cubic  Hermite  polynomials  can 
be  used  for  unequal  intervals  or  nonuniform  grids. 
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APPENDIX 


EVALUATION  OF  THE  SMOOTHING  INTEGRAL 

A  piecewise  cubic  Hermite  polynomial  in  the  interval  [0-j_i ,/3-j ]  is  repre¬ 
sented  in  terms  of  the  basis  functions  and  the  state  vectors  x.j,  where  the 

state  vectors  are  defined  as  in  Eq.  (20).  By  changing  the  independent  variable 


below. 


t  =  {-Pi-i 


Then  the  smoothing  integral  in  the  interval  [3i  _i , 3  becomes 

Ai-1  • 

Ii-i,i  »  JQ  [Pi-l,i<t>]*dt  (A2) 

where  A-j_i  =  t -j - 1 ^ ^  A-j_i*A-j. 

With  the  change  of  the  variable  above,  the  second  derivative  of  the  Hermite 
polynomial  can  be  written  as 


4>i,i(t) 


Pi-1, i(t)  ■ 


*i,l(t)  xi 


xi -1 


i 

♦i,0(t) 


where  the  second  derivatives  of  the  basis  functions  can  be  derived  as  follows. 
Using  the  change  of  variables,  we  rewrite  the  basis  functions  as 

4>i,l(t)  =  tMSAi-i-ZtJ/Ai-i* 

*i,l(t)  =  t*  ( t — A  -j—iJ/Ai  —  !2 

♦i,0(t)  =  (Ai-i-t)2 (Ai_i+2t)/Ai_i3 

♦i,0(t)  =  t  ( A-j  _j-t ) 2  A-j  _!  2  (A! 


Then,  taking  the  second  derivative  with  respect  to  t  yields 

♦i,l<t)  *  6(Ai.1-2t)/Ai-1» 

«»i,l  »  (St-aAi-iJ/Ai-i* 


♦i  ,0  =  6(2t-A-{-i)/Ai_i» 


♦i  ,0  =  (6t-4A-j-i)/Ai-i* 

Therefore,  the  integrand  of  the  smoothing  integral  is  expressed  as 

T 


[Pi-l,i(t)3*  = 


L  L 


Ki-l,i(t) 


Xi 


J  L  Xi-ij 


(A6) 


(A7) 


where  is  defined  as 

Ki-l,i(P)  = 


♦i,l00*i,l(u)  /  +1,1 00*1,1 00 

•I  II  ll  II 

♦l,l(»0+i,i(l0  *  +i , l (M)+i , i (m) 


♦i ,1  (*A>«*»i ,0<IA)  *  4>i,l(4)+i,o(iO 

II  II  II  ll 

♦i,lOO+1,oOO  »  *i , 1 ,o(p) 

If  II  II  II  II  ll  II  II 

**»i  ,0  ,  1  (M)  ,  ^1 , 0  ,  1  CM)  ,  'J'i,o(fO+i,0(P)  *  ,o(JJ) 

II  It  II  II  II  II  II  II 

+i , 0 ( M ) 4>i ,  1  (p)  ,  4»i ,o(M)^i ,  1  (*Ji)  ,  ^i  ,0(M)«l»i  ,0(M)  ,  +i  ,o(P) 

By  utilizing  the  above  equation,  the  smoothing  integral  becomes 


(A8) 


!i-l. 


‘i-1 


,A  i-1 

/0  Ki_lf i (t)dt 


Xi 


i-1 


(A9) 


Evaluating  the  above  integral,  we  obtain 


A-i-1 

/„  Ki-i,i(t)dt 


-6/Ai-!* 

-12/A-j-!3 

-6/Ai-!3 

9 

-6/Ai.j* 

4/Ai-i 

6/Ai-j* 

2/Ai-l 

9 

-12/A1*_1S 

M 

1 

•r 

< 

\ 

tO 

12/Ai-j3 

6/Ai-!* 

| 

-6/Ai-i* 

2/Ai-i 

6/Ai-i* 

4/Ai-i 

i 

(A10) 


Matrices  and  are  defined  as  follows: 

r  i 


Ai-1  = 


0  1 


(All) 


_3 

.2 

12Ai_i 

-6Ai-i 

=  —2 

-6Ai_! 

4Ai-i 

(A12) 


where  is  a  symmetric  matrix.  Equation  (A10)  can  then  be  expressed  as 


—  1 

-Bi-lA-j-i 


_i  T  -1 

(~Bi-lAi-l )T  Ai-lBi-lAi-i 


(A13) 


where  B^.j  and  A-j_j  are  functions  of  the  variable  Ai_!.  By  using  the  above 
notation,  Eq.  (A9)  is  rewritten  as 


l». 

I'* 


[;? 

v 

h> 

W.4 

H* 


k 

! 


s: 

m 

to 

tft 


to 


ft 

£ 


to 


B 


e_ 
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INTRODUCTION 


The  smoothing  of  gradients  can  be  obtained  by  using  an  optimization  method 
for  approximation  involving  spline  functions.  A  nonuniform  grid  may  be  employed 
to  compute  by  the  spline  function  method  with  cubic  hermite  polynomials. 
Continuous  second  derivatives  at  the  grid  point  from  both  sides  are  essential 
for  the  purpose  of  smoothing.  This  method  can  be  applied  to  solve  the  following 
problems:  whether  the  platform  can  climb  on  the  estimated  in-path  slope  or 
whether  it  will  tip  over  the  estimated  cross-path  slope. 

RECURSIVE  FILTERING  AND  SMOOTHING  PROCEDURE 

A  spline  function  s({)  is  a  solution  to  the  optimization  problem 

N  N  0-j 

J*  *  Min.  {  E  thOSiJ-mijTRi  [h^)-*^  ♦  p  E  /  [h]*d?(  (1) 

h  e  C*  i«l  i*2  Pi-1 

where  for  clarity  and  simplicity  in  discussion,  we  c  K  consider  the  cubic 

spline  case.  A  higher  order  polynomial  spline  can  also  be  treated  in  a  similar 

manner  with  more  complicated  computations. 

A  cubic  spline,  s,  is  a  piecewise  polynomial  of  class  C*  which  has  many 

good  properties,  such  as  the  minimum  norm  property  and  local  base  property  (refs 


1,2).  From  the  approximation  theory,  we  know 

a'l>  s'nI'  there  exists  a  unique  cubic  spline 

that  for  each  set  A  =  {aj,. 

s ( { ; A)  such  that 

.  . ,aN, 

s(0.j;A)  ■  a-j  ,  i  « 

1,2,  ...,N 

(2) 

S(0i;A)  »  a'^,  i 

«  1,N 

(3) 

where  s  is  the  first  derivative  of  the  function  s.  The  above  equations  can  be 


^Ahlberg,  J.  H.,  Nilson,  E.  N.,  and  Walsh,  J.  L.,  The  Theory  of  Splines  and 
Their  Applications,  Academic  Press,  Inc.,  1967. 

2Schumaker,  L.  L.,  Spline  Functions:  Basic  Theory.  John  Wiley  &  Sons,  1981. 


thought  of  as  boundary  conditions  for  the  piecewise  cubic  spline  interpolation 


given  a  set  of  data  (/3-j,a^),  for  i  =  1,2, _ ,N.  Thus,  solving  the  problem  in 

Eq.  (1)  is  equivalent  to  determining  a  set  of  constraints  A  for  the  optimization 
problem: 

N  N  Pi 

J*  =  Min  {  E  [s(5i:A)-mi]TRi  Is ( C i s A) -m ^ ]  ♦  p  E  /  [s ( ? ; A) ] =d? }  (4) 

A  i=l  i=2  0i-l 

Instead  of  taking  a  direct  approach  to  find  an  optimal  set  of  constraints  for 

the  problem  above,  it  is  proposed  to  further  transform  this  problem  into  a  form 

which  is  convenient  to  be  solved.  From  the  theory  of  numerical  analysis  (ref 

3),  it  is  well  known  that  a  piecewise  cubic  Hermite  polynomial  p(£)  is  in  the 

family  of  C1 .  For  each  set  B  =  AuAc,  where  Ac  is  a  complement  of  A,  i.e.,  Ac  = 

{a'i,  i  =  2,3, . . . ,  N— 1 }  ,  then  B  =  ja^.a'-j,  i=l,2, . . .  ,N( ,  there  exists  a  unique 

piecewise  cubic  Hermite  polynomial  p(£;A)  such  that 

P($i»8)3a-j  ,  i  =  1 . 2 , . . . ,N  (5) 

P(fli  ;B)  . N  (6) 

where  p  is  the  first  derivative  of  p. 

It  should  also  be  noted  that  for  each  set  A,  there  are  an  infinite  number 

of  piecewise  Hermite  polynomials  p($;A)  such  that 


P(/5i ; A)  =  a^  , 

i  =  1,2 . N 

(7) 

P(ffi ;A)  ■  a'  i 

,  i  =  1 ,  N 

(8) 

Let  a  set  of  p({;A)  which  satisfies  the 

constraints  in  the  equations 

above  be  P, 

i.e.. 

P  =  i p( ? ; A) : ( 5 ) 

, ( 6 )  satisfied) 

(9) 

3Burden,  R.  [T- et  al.,  Numerical  Analysis,  Prindle,  Weber,  &  Schmidt,  1978. 


Referring  to  the  paper  by  de  Boor  (ref  4),  it  is  noted  that  there  exists  a 
unique  cubic  spline  s((;A)  in  the  set  P.  Also  from  the  minimum  norm  property  of 


a  cubic  spline,  we  have  the  following  relation: 

N  fit  H  fli 

E  /  [s(*;A)]*d*  <  I  /  [p(«jA)]*d« 

i-2  0i-l  i-2  0i-l 


That  is 


where 


N  |3  • 

E  /  1  [s(*;A)]*d*  -  inf  Jp(p) 

i-2  0i-l  p  e  P 


Jp 


N 

*  L 

i-2  fli-1 


[p(C;A)]*d? 


(9) 


(10) 


(11) 


Since  a  cubic  spline  s((;A)  is  unique,  a  piecewise  cubic  Hermite  polynomial 
p((;A)  which  minimizes  the  smoothing  Integral  Jp  in  the  above  equation  with 
respect  to  Ac  becomes  a  cubic  spline  s({;A).  To  be  more  precise,  we  have  the 
following  theorem. 


THEOREM:  Let  P  represent  a  set  of  piecewise  cubic  Hermite  polynomials  p 
which  satisfies  the  constraints  below: 

P(8i ;AC)  -  ai  ,  i  -  1,2, ...N  (12) 

p(Bi;AC)  -  a**  ,  i  «  1 ,N  (13) 

where  p  c  C1,  A,  and  Ac  are  the  same  as  mentioned  before.  Then  there  exists  a 
unique  cubic  spline  s(()  such  that 

N  fii  N  Pi 

E  /  [s(<)]*d*  -  Min  E  /  [p(( » Ac) ] *d£  (14) 

i-2  *1-1  AC  i-2  ffi-1 

where  s  and  p  are  the  second  derivatives  of  functions  s  and  p  and  s  c  C*.  A 
simple  example  with  N  -  3  is  given  next. 

*de  Boor,  C.,  "Bicubid  Spline  Interpolation,"  J.  Math  Phvs. .  Vol.  41,  1962, 
pp.  212-218. 


EXAMPLE  FOR  C*  CONTINUITY 


For  convenience  and  simplicity,  we  only  consider  a  special  case  with  N  =  3. 
The  node  points  are  given  as  0j,  02<  an^  03-  The  intervals  are  not  equal,  i.e., 

(02-0i)  *  (03-02)  (15) 

Let  a  set  of  piecewise  cubic  Hermite  polynomials  p  be 

P  =  [p(t ; Ac)  ,  p£C  [t1,t3],  p(t2)  =  a,  a  e  Ac]  (16) 

which  satisfies  the  constraints  in  the  equations  below: 

p ( t ; Ac )  =  a,  ,  for  i  *  1,2,3 
P  ( t  -j ;  Ac )  •  a',  ,  for  i  *  1,3  (17) 

In  this  special  case,  a  set  Ac  =  a'2  *  a. 

We  want  to  show  here  that  the  cubic  Hermite  polynomial  p(t;Ac),  which  is 
obtained  by  minimizing  the  smoothing  integral,  will  become  a  cubic  spline  func¬ 
tion  s(t)  £  C*[tj,t3] 

t2“  t3 

J*  *  Min  {/  Ip( t ; A* ) J *dt  ♦  /  [p( t ; Ac) J *dt } 

AC  t2* 

t3“  t3 

*  Min  {/  [p(t;a)]'dt  ♦  /  [p(t;a)]ldt}  (18) 

a  M  t2* 

From  Eq.  (A14)  of  the  Appendix,  the  smoothing  integral  above  can  be  written  as 

J(a)  *  (x2-A1xj)tBi  (x2"a1x1)  +  (*3-A2*2)TB2  (*3^2X2)  (19) 

~  1 

where  A^,  B,  ,  and  x^  are  defined  in  the  Appendix,  and 

x,  »  ( a i , a ’ i ) T  ,  with  a'2  *  a  ,  i  *  1,2,3  (20) 

-  di-j  «  t  -j  - 1  -j  _  x  (21) 

Using  Eqs.  (All)  and  (A12),  the  functional  J(a)  is  written  as 


END 
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